Impairment-based robotic intervention for reaching function